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1. Introduction 



A fundamental problem which must be resolved in virtually all non-trivial robotic operations is the well-known 
inverse kinematic question. More specifically, most of the tasks which robots are called upon to perform are specified in 
Cartesian (x.y.z) space, such as simple tracking along one or more straight line paths or following a specified surface 
with compliant force sensors and/or visual feedback. In all cases, control is actually implemented through coordinated 
motion of the various links which comprise the manipulator; i.e. in link spacer-* As a consequence, the control computer 
of every ‘^sophisticated*’ anthropomorphic robot must contain provisions for solving the inverse kinematic problem 
which, in the case of ^simple’ 4 , non-redundant position control, involves the determination of the first three link angles. 
,0„ 0 2 , and 0„ which produce a desired wrist origin position p, w , p yw , and p tw at the end of link 3 relative to^some fixed 
base frame, as 'further explained in (1]. „ t-- ■ 
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which "solves” (1) for a given or desired X is not nearly, as sfi-aightfbpvdra, although analytical inverse kinematic solu- 
tions do exist for virtually all current industrial manipulators. It jpiglit be noted, however, that these analytical inverse 
kinematic solutions are usually non-unique and sequentialNunHurther require the evaluation of some rather complex 
Atan2 functions— see Summary Sheet 3.4.57 of [1], for exgifipte^ which presents one such solution for the PUMA 560 
industrial manipulator. t 

We should also note that this problem becomes significant^ more complex when the orientation question is 
addressed simultaneously; i.e. when a desired end^effector or tpoforientation is specified in addition to its position. Cer- 
tainly, my technique which can "simplify" solutions to tlje-’lnverse kinematic question in robotics can have a significant 
impact not only on the computational requirements' j*^6lved with robot control, but also on the diversity of tasks the 
manipulator can perform. The primary purpose of/us)te%er will be to thoroughly evaluate, extend, and demonstrate a 
new computational technique for solving the complete configuration (position and orientation ) inverse kinenuuic problem 
fnr a variety of multi-link manipulatory Si. & 

■tm'themest sectionrwe WH^outlme ihWnewJn^ verse kinematic solution and demonstrate its potential via so 
recent computer simulations “• -**— » t tr\ rurrpnf mv»»r»:p method* rind outline some otZ 
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number of practical consequences . ( 
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modifications to and/or extensions of qusjn^w inverse kinematic result. 

2. A Complete Inveifce Kinematic Solution 

To motivate the moi^kgeneral, six degree of freedom solution to the inverse kinematic problem associated with the 
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overall configuration of the end effector, we will first present a solution to the three degree of freedom inverse kinematic 
problem associated with only the position of (say) the wrist origin associated with the end of the third link of a six link 
manipulator. The particular sotution given here follows directly from that given in [2] with J T replaced by J~‘, as sug- 
gested in [21 and later implemented in [3], where J denotes the well known Jacobian matrix of the manipulator. More 
specifically, the time differentiation of (1) directly implies that 
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with the Jacobian J being a matrix of partial derivatives, as specified via equation (3). 

In light of the preceding, now consider the closed loop dynamical system depicted in Figure 1, which is “driven” 
by some desired wrist origin position in Cartesian space, namely 


X d = 


Pxwd 

Pywd 

Pzwd 


(4) 


It can be noted that in Figure 1, K might be a (3x3) arbitrary, diagonal, time-invariant gain matrix, 0, would be a time 
varying 3*vector system output which represents the derivative of the desired link angle displacement which, when 
integrated, yields the 3-vector output representative of the link angle displacement, 0, , and G( ) represents the forward 
kinematic operator defined by equation (1). 

We might next define the equations which describe the dynamical behavior of the Figure 1 system, namely 

0, = J" t (05)K(X d - X.) , (5) 


and 


X, = GOO • (6) 

Clearly, the premultiplication of (5) by J(0,) and the subsequent substitution of X* for J(0,)0«, in light of (3), then implies 
that 

X,= K(Xd-X s ), (7) 

or that X, has a dynamical system representation as depicted in Figure 2. The reader will immediately recognize the sys- 
tem of Figure 2 as a parallel combination of three relatively simple, decoupled, first order, linear, time invariant systems 
with arbitrarily adjustable (via the elements of K) stability properties. In particular, if X d represents a step input of mag- 
nitude Xj (actually a 3-vector step input), applied at time to, then it is easy to show that for zero initial conditions on X„ 

X,(t)= [l - e -K(Hl>) ]x d , (8) 

or that for K positive definite, X,(t) will track the desired Cartesian position X d (t) = X d with an (arbitrarily fast) exponen- 
tially decaying error! In light of (6), it therefore follows that 0,(0 can be made to approach the desired 0 d which 
corresponds to X d = G(0 d ) arbitrarily fast as well. 

The reader might next note that in order to make this inverse kinematic procedure applicable to more general 
forms of robotic motion, it has to be “extended” to include inverse orientation information as well; i.e. solutions for 0 4 , 
0j, and 0 6 of a general six link manipulator. However, the extension of the Figure 1 system to include orientation as 
well as position is a non-trivial task, since (i) there is no 3-vector representation for orientation and (ii) even if there 
were, die Figure 1 system would then require an analytical expression for the inverse of a corresponding (6x6) Jacobian, 
a formidable computational task. In light of these observations, we will now present, for the first time, a complete 
dynamical system solution to the inverse kinematic problem for both position and orientation. 

To begin, we first note that the orientation of (say) the tool frame relative to the fixed base frame can lie, and often 
is, specified by an appropriate (3x3) orientation coordinate transformation matrix, often called a rotation matrix, of die 
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form (using the notation in [1]): 

Ro = [a,n,s] = 

where the orthogonal unit vectors a, n, and s represent the approach , normal , and sliding vectors associated with the 
orientation of the tool frame relative to some fixed base frame. Furthermore, since s can be obtained via the vector 
cross-product relationship: 

axn = s , (10) 

as described in Cl], knowledge of a and n alone will uniquely specify orientation of the end effector. 

We next note that if 

to = 

represents the angular velocity of the tool frame, then it is not difficult to show, in light of Figure 3, that to can be 
represented by the sum of its “translational component” relative to the motion of a, namely the cross product axa, where 

a = — , and its “rotational component” relative, to the motion of a, namely the scalar velocity dot product ns multiplied 

by a; i.e. 
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to = axa + (n*s)a . (12) 

Furthermore, it now follows by expanding (12) in light of (9) that to is also given by the following matrix-vector product: 
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The results which now follow build on the material presented in Section 4.3 of [1] which pertains to so-called 
spherical wrist manipulators. In such cases, (4.3.2) of [1] establishes the fact that 
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or that the (6x6) Jacobian matrix associated with spherical wrist manipulators can be “triangularized”, with J x . a 0x3) 
“positional” Jacobian associated with the velocity of the wrist origin relative to motion of the first three links, and J R a 
(3x3) “orientation” Jacobian associated with the angular velocity of the end effector frame relative to the motion ol the 
final three links. 
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(15) 



for a known G(*), with corresponding 

Pw 

X = n 
a 

As defined, X completely specifies both the (wrist origin) position* and the (end effector) orientation of any given mani- 
pulator. 

Now consider the dynamical system depicted in Figure 4, which we claim “solves* ’ the inverse kinematic problem 
associated with the complete configuration of six link, spherical wrist manipulators. In particular, the dynamical equa- 
tions associated with Figure 4 are 

8, = Jt(e,)K [x d - X,] , (19) 

with K a diagonal (9x9) gain matrix, and 

X, = G(9») • < 20 > 

Since 6, is also equal to JKOJX,, in light of (16) and (18), with X, arbitrary, (19) implies that 

X, = K[x a -X,], (21) 

or that the 9-vector X, is analogous to the 3-vector X s of (7). This in turn implies that X s W ‘N track the desired Carte- 
sian configuration X d with an (arbitrarily fast) exponentially decaying error! As we noted earlier, it therefore follows that 
0 s (t) can be made to approach the desired 9 d which corresponds to Xd - G(0 d ) arbitrarily last as well. In other words, 
the Figure 4 dynamical system solves for the first time the complete inverse kinematic problem for virtually any six link, 
spherical wrist manipulator. 

Figures 5 and 6 depict actual simulated runs of the Figure 4 system for the PUMA 560 industrial manipulator, as 
mathematically described in [1], when the (end effector) position vector (p x ,p y ,p<) goes from (3.5, 2.5, 2.9) at t 0 : = 0 to 
(1.5, 2.0, 4.4) at t f = 5 along a LSPB (Linear Segment with Parabolic Blend) trajectory* while the orientation of the end 
effector frame undergoes a simultaneous smooth transition for (n x , ny, n t , a x , a y , aj from (0, 0, -1, 0, 1, 0) to (-1, 0, 0, 0, 0, 
-1) over tiie same 5 second time interval. Only four of the nine elements of X are explicitly depicted, and in both cases, 

QThc lcmi link s P° ce ralhcr to™ j oiAl space wia h* UScd hcrc for rcaso “ which are dclincalal in Scction l -4 °f IU- 
f or course, for spherical wrist manipulators, knowledge of the wrist origin position and a, the approach vector, directly implies knowledge of the 
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the initial conditions on 9, were appropriately set to insure that X, (0) — Xa (0) . It might be noted that in the Figure 5 
tuns all nine of the nonzero, diagonal elements of K were set equal to 10, while these same nine elements were increased 
to 100 for the Figure 6 runs. The reader will note that a rather small error exists between the desired and simulated 
dynamical system configuration parameters depicted in the K=10 case. Moreover, this small error is essentially elim- 
inated by increasing the (elements of the) diagonal gain matrix K to 100, as depicted in Figure 6; i.e. the desired and 
simulated configuration parameters are so close that they are virtually undistinguishable in this latter case! This, in turn, 
implies corresponding dynamical system link output displacement values which are “very close” to those which would 

Pwd 

mathematically solve the inverse kinematic question for the given, desired Xd = °u , especially in the K=100 case. In 

3d 

summary, therefore. Figures 5 and 6 clearly illustrate the employment of the Figure 4 dynamical system as a viable 
alternative technique for solving the inverse kinematic question for a large class of multi-link manipulators. 

A number of observations are now in order relative to this dynamical system inverse kinematic solution. First of 
all, we note that 6, is also obtained as an output of our dynamical system solution without explicit knowledge or use of X 
j Tli is could prove most useful in the implementation of a variety of control schemes which require desired link veloci- 
ties as well as positions; e.g. in relatively simple PID controllers, where D denotes the (time) derivative of the link posi- 
tional drive signal. 

We next note that because of the spherical wrist assumption, we actually can determine an analytical expression for 
the (6x9) “inverse” Jacobian, J t (0), as defined by equation (16). For example, such an analytical expression is essen- 
tially given in Example 4.3.23 of [1] for the PUMA 560 industrial manipulator. Certain earlier reports and texts have 
implied that analytical expressions for J -1 in the six link case are virtually impossible to obtain. In [1) we show that this 
is not necessarily the case for spherical wrist manipulators, and here we exploit this observation to extend a three- 
dimensional inverse kinematic positional result to the more general and important, six-dimensional configuration case. 

We further note that the particular inverse kinematic (position and velocity) solutions we obtain via the dynamical 
system of Figure 4 will be unique, and will depend on the initial conditions associated with the system. Different initial 
conditions can be used to produce all of the solution sets associated with a given manipulator, if desired, or only the par- 
ticular one “best suited” to a specific task, such as (say) an arm right, elbow above trajectory for the PUMA 560 (see 
Figure 3.4.56 of [l]). 

We finally observe, again in light of Figures 5 and 6, that there is no need to sequentially solve a set of rather 
complex and time-consuming Atan2 functions associated with a given robot to obtain the inverse kinematic link displace- 
ments associated with a desired Cartesian configuration. Although the computational savings associated with the direct 
employment of die Figure 4 dynamical system, rather than the explicit solution of a sequential set ot Atan2 functions, 
has yet to be completely determined, there is reason to believe that such savings can be raiher significant. 


3. Practical Consequences to be Investigated 


There are numerous practical consequences associated with the new computational inverse kinematic procedure 
which has just been outlined, and the primary purpose of this section will be to delineate some ot them, lo begin, we 
might a«ain note the obvious, namely that the procedure can be directly utilized to produce desired link positional and 
velocity’ drive signals to the link motors which then might be controlled by any “standard procedure”, such as a unity 
feedback PID compensator, without the explicit evaluation of any analytical Atan2 functions. Ot course, m such cases 
and in the others which we will outline in this section, it is important to realize that a flexible control computer must be 
employed in order to physically realize (say) the Figure 4 feedback system. In light of this observation, it is of interest 
to note that a truly significant amount of robotics development effort within LEMS at Brown University over the past 
year has focused on die development of one such flexible control computer for robotic applications, namely SIhRA (Sys- 
tem for Implementing and Evaluating Robotic Algorithms). 


SIERA is a unique multiprocessor system composed of two subsystems-a tightly-coupled real-time servo system 
and a loosely coupled multiprocessor network (the “Armstrong system”), as depicted in Figure 7. A shared memory 


end effector position as well, as is shown in [11. 


X Doth references [1] and [6] describe such LSPB trajectories. 
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interface allows communication between these two subsystems. The architecture is flexible enough to accommodate a 
variety of robots and sensors, since all robot dependent hardware is restricted to the robot interface board. Thus, we 
have been able to control the Unimation Puma 560 and the IBM 7565 robots that are currently in our laboratory. A 
detailed description of the S1ERA hardware can be found in [4]. 

The SIERA operating system provides a flexible development system for research in robotic algorithms, without 
making the system too complex to be used for instructional purposes. This is accomplished by defining three different 
programming levels: i) the user level, which is analogous to a commercial system such as Unimation’s VAL robot com- 
mand language, ii) the researcher level, which fulfills the main objective of SIERA by allowing any type of robotic algo- 
rithm to be added to the system, and iii) the expert level, which is used to add a new robot or to enhance the operating 
system. It should be noted that the operating system is also generally applicable since all (low-level) robot tasks are han- 
dled by interfxe routines written by an expert level programmer. Father details of the operating system and the pro- 
gramming levels can be found in [5]. 

Another potential use for our inverse kinematic procedure which has yet to be fully exploited is in the automatic 
avoidance of d- generate configurations . such as those associated with Jacobian singularities. To be more specific, it is 
well known t!^; certain desired Cartes. an trajectories may imply corresponding link trajectories for which |J(0)|, the 
determinant of the Jacobian, approaches zero. In such cases, excessive link velocities are required to produce seemingly 
well-behaved Cartesian motion. We feel that one way of automatically avoiding such degenerate configurations could be 
to physically restrict the magnitude that | J(0 S ) | can decrease to in either the Figure 1 or the figure 4 system. Although 
such a procedure will not yield the desired Cartesian trajectories, hopefully it will yield “acceptable” Cartesian trajec- 
tories which are “close to” the specified ones. Some preliminary computer simulations bounding |J(0 4 )| have produced 
rather encouraging results, and one of the primary objectives of" our continuing research will be to thoroughly investigate 
this and other automatic degenerate configuration avoidance techniques. 

Another potential use of our inverse kinematic procedure is that associated with redundant manipulators-, i.e. mani- 
pulators which have more degrees of freedom than are necessary to achieve (say) desired end effector orientations. To 
be more specific, it is well known that the inverse kinematic problem associated with redundant manipulators can have 
an infinite number of solutions, and the problem then becomes one of appropriately selecting the “best” solution from 
this infinite set. It might be noted that one way of obtaining a variety of different link solutions, (say) in light of Figure 
1, is to employ “different right inverse” Jacobians instead of the square I -l (0j) depicted. Our investigations are continu- 
ing to determine how a “best right inverse” Jacobian might be selected and utilized in our computational inverse 
kinematic procedure in order to automatically yield a correspondingly “best” inverse kinematic solution for redundart 
manipulators. 

Another potentially important application of our computational inverse kinematic procedure concerns its employ- 
ment in more sophisticated control strategics where knowledge of 0 s (t), as well as 0 s (t) and 0,(0. would be used. One 
such example is that associated with the inverse dynamic, feedforward compensation procedure outlined in Section 8.5 of 
(Ij. We have already conducted some preliminary simulations of an“exiended” version ot the Figure l and Figure -1 
dvnamical svsterns (“extended” by the addition of another parallel bank of integrators as well as appropriate feedback 
earn matrices) in order to produce 0 S as well as 0 S and 0 S . One such “extended” system is depicted in Figure 8 in its 
simplest (positional) form. The mathematical equations associated with such a dynamical system can directly be shown 
to imply an analogous linear, time-invariant, second order differential equation relationship between input X d (t) and out 
put X\(t) , namely 

X\(t) + AX s (t) + KX s (t) = X d (t) , (22) 

which can then be used to establish convergence relations between 0,(0 and its derivatives and the desired 0 tI (t) and its 
derivatives. Results in this area are still under development. In particular, we are currently working on a more complete 
mathematically understanding of the Figure 8 system, including the implications regarding the 0,(0. UdO, ;liul Ugt) thus 
obtained, when compared to the desired values of 0 a (0 and its derivatives in both the simple (positional) case depicted 
and the full six degree of freedom configuration case. Here again, our initial simulations have been encouraging and we 
are actively continuing these investigations. 
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4. Summary 

We have now outlined a new computational procedure for solving the inverse kinematic question for a large class 
of multi-link manipulators. Furthermore, we have mathematically established the “equivalence” between this computa- 
tional procedure and the behavior of relatively simple first and second order, linear, time-invariant dynamical systems. 
We have indicated a number of potential practical consequences associated with the employment of this technique in 

robotic applications, namely: . . . ... , , . 

(i) its use in directly obtaining unique values for the inverse kinematic positions, velocities, and accelerations, 

(ii) its potential for automatically avoiding degenerate configurations, 

(iii) its ability to produce the “best” inverse kinematic solutions for redundant manipulators, and 

(iv) its employment in more sophisticated motion control strategies, 

We have expended a considerable amount of time and effort within LEMS in constructing a general purpose, flexi- 
ble robot control system (SIERA) which can be used to thoroughly implement, test, and evaluate all aspects of our robot- 
ics research program, and we have two industrial manipulators (a PUMA 560 anthropomorphic robot and an IBM RS/1 
Cartesian robot) to employ in our studies. Our investigations are well underway, and we are very optimistic that 
significant new techniques for robot control and manipulation will result as a consequence of these investigations. 

References 

[1] Wolovich, W. A., Robotics: Basic Analysis and Design, Holt, Rinehart and Winston, 1986. 

[2] Elliott, H. and Wolovich, W. A., A Computational Technique for Inverse Kinematics, Proceedings of the 1984 

Conf. on Decision and Control, Las Vegas, NV Dec. 1984. 

[3] Vaccaro, R. J. and Hill, S. D., “A Joint-Space Command Generator for Cartesian Control of Robotic Manipula- 
tors,” Department of Electrical Engineering, University of Rhode Island, 1986, (to appear). 

[41 Kazanzides, P., Wasti, H., Weinstein, R., and Wolovich, W. A., “SIERA: System for Implementing and Evaluat- 
ing Robotic Algorithms,” Brown University Technical Report LEMS-23, June, 1986. Also to be presented at the 
1987 IEEE International Conference on Robotics and Automation in Raleigh, NC March 30 - April 3, 1987. 

[5] Kazanzides, P., Wasti, H„ and Wolovich, W. A.. “SIERA: A Multiprocessor System for Robotics,” Proceedings 
of the SP1E Symposium on Advances in Intelligent Robotic Systems, Cambridge, Mass., Oct. 1986. 

[6j Craig, John J., Introduction to Robotics: Mechanics & Control, Addison-Wesley Publishing Company, 1986. 



Figure 1 

A Positional Inverse Kinematic Solution 
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